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摘 要 : 在 二 维 复杂 环境 中 ， 为 了 避免 机 器 人 运动 规划 中 可 能 出 现 的 局 部 陷阱 和 过 早 收 化 问题 ， 提 出 一 种 改进 的 元 
启发 式 算法 一 自 适 应 遗传 算法 。 首 先 ， 利 用 随机 Dijkstra 算法 创建 初始 种 群 ; 然后 ， 在 遗传 算法 的 每 一 代 中 ， 改 进 
所 创建 的 路 径 ， 并 用 自 适 应 算 子 替代 常规 选择 算 子 ; 最 后 ， 通 过 搜索 过 程 中 的 反馈 信息 ， 可 以 令 自 适应 选择 算 子 在 
整个 算法 运行 中 恰当 地 控制 选择 压力 。 为 了 验证 所 提 方 法 的 有 效 性 ， 在 MATLAB 中 进行 了 仿真 实验 ， 并 将 所 提 方 
法 与 另外 两 种 典型 方法 进行 了 对 比 。 实 验 结 果 表 明 ， 提 出 的 方法 可 以 有 效 避 免 路 径 规划 中 的 局 部 收敛 问题 ， 且 在 复 
杂 环境 中 也 可 以 产生 可 行路 径 。 
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Robot motion planning based on adaptive selection operator combined with genetic algorithm 
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618000, China; 2. School! of Software, Shanxi University, Taiyuan 030013, China) 


Abstract: In order to avoid local-trap and premature convergence of robot motion planning in 2D complex environments, 
this paper proposes an improved metaheuristics-adaptive genetic algorithm (GA) . Firstly, it adoptes the random Dijkstra 
algorithm to create initial population; secondly, in each generation of the GA, improves the created paths, and replaces the 
conventional selection operator in GA with an adaptive one; finally, by using feedback information of the search process, the 
adaptive selection operator can control the selective pressure appropriately throughout the algorithm. To validate the 
effectiveness of the proposed method, compares the algorithm with two other methods in MATLAB. The results show that 
the proposed method can avoid the local convergence problem in motion planning, and can generate feasible path in 
complex environments. 


Key words: mobile robot; motion planning; genetic algorithm; adaptive selection operator 


0 ”引言 运动 。 此 外 ， 将 机 器 人 只 显示 为 一 个 点 ， 即 点 机 器 人 。 如 果 


串 


机 器 人 的 形状 是 多 边 形 ， 则 仍 将 其 显示 为 点 ， 但 是 会 扩大 障 
具有 自主 运动 能 力 的 机 器 人 一 直 都 是 工程 界 和 学 术 界 的 碍 物 以 提供 安全 的 余 量 。 考 虑 到 关于 机 器 人 运动 、 形 状 和 环 

研究 焦点 。 因 此 ， 机 器 人 运动 规划 问题 已 经 成 为 计算 机 、 控 境 的 所 有 简化 ， 机 器 人 运动 规划 仍然 是 一 个 NP 问题 中 。 
r= 制 等 领域 的 研究 人 员 的 关注 热点 出 。 然 而 机 器 人 运动 规划 却 为 了 快速 搜寻 起 点 至 终点 的 最 佳 路 径 ， 国 内 外 学 者 进行 
《9 是 一 个 相对 复杂 的 问题 ， 如 真实 三 维 环境 中 的 平移 和 旋转 。 了 大 量 的 研究 ， 得 到 了 很 多 有 价值 的 成 果 。Lozano-Perez 等 
一 般 来 说 , 机 器 人 的 运动 由 与 其 自由 度 (degrees of freedom， 人 针对 机 器 人 在 多 面体 障碍 物 之 间 运 动 问 题 ， 提 出 了 一 种 基 


DOF ) 数量 相对 应 的 多 个 参数 决定 。 由 于 机 器 人 运动 规划 的 ”于 可 见 度 图 的 路 径 规划 算法 ， 并 通过 空间 配置 对 其 进行 了 扩 
理论 复杂 度 是 DOF 数量 的 指数 倍 , 所 以 在 大 多 数 文献 中 , 需 展 由 。 为 了 最 大 限度 地 减少 机 器 人 与 障碍 物 的 碰撞 ，Khatib 
要 借助 一 些 限制 于 假设 来 简化 问题 的 求解 ， 如 简化 环境 中 存 。 首先 提出 了 人 工 潜在 场 方法 ， 建 立 由 目标 点 和 障碍 物产 生 的 
在 的 障碍 物 的 形状 、 机 器 人 运动 的 类 型 和 机 器 人 的 形状 等 。 吸引 力 场 和 排斥 力 场 ， 机 器 人 利用 势 函数 的 负 和 斜率 向 目标 移 
在 本 文中 假设 机 器 人 运动 环境 为 一 个 二 维 (two dimension， 动身。 然而 这 种 方法 可 能 会 使 机 器 人 陷入 潜在 局 部 最 小 值 。 

2D) 平面 ， 并 且 对 路 径 中 障碍 物 的 形状 没有 限制 。 为 了 降低 路 径 的 不 平滑 和 非 连续 的 问题 给 机 器 人 带 来 的 影响 
在 许多 研究 中 ， 障 得 物 只 能 以 凸 边 形 的 形状 出 现 ; 然而 ”文献 [@] 利 用 也 样 条 技术 来 双 近 机 器 人 运动 路 径 , 进而 实现 机 
在 本 文中 ， 障 得 物 可 以 任何 形状 存在 。 因 此 ， 所 提出 的 算法 器 人 路 径 规划 。 除 了 以 上 方法 ， 近 些 年 相关 学 者 还 提出 了 


NS 


能 够 解决 更 多 的 运动 规划 问题 。 一 般 来 说 ， 存 在 两 种 机 器 人 Voronoi 图 上 中、 动态 规划 馈 、 快 速 搜索 随机 树 匀 、 元 胞 自动 机 
运动 环境 中: 09、 神经 网 络 叫 、 混 成 通信 顺序 进程 时 、 曲 蚁 算法 M3 妆 、 元 启 
a) 静态 环境 。 其 中 障碍 物 的 位 置 固定 ， 并且 在 机 器 人 朝 ” 发 式 "4 等 算法 ， 取 得 了 很 多 有 价值 的 成 果 。 但 是 由 于 这 些 方 
向 目标 移动 时 不 改变 。 法 在 计算 复杂 度 、 局 部 最 优 、 重 棒 性 等 方面 的 劣势 ， 所 以 需 
b) 动态 环境 。 机 器 人 移动 时 障碍 物 的 位 置 可 能 会 改变 。 ”要 对 这 些 方法 进行 改进 。 为 了 解决 局 部 陷阱 问题 ， 文 献 [15] 


上 


本 文中 假设 环境 是 静态 的 ， 且 机 器 人 的 运动 仅 限于 平移 ”中 提出 了 一 种 用 于 2D 环境 中 机 器 人 运动 规划 的 遗传 算法 
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(genetic algorithm，GA)， 研 究 了 GA 在 机 器 人 运动 规划 中 
的 应 用 潜力 。 在 此 基础 上 上， 文献 [16] 分 别提 出 了 基于 并 行 精 
英 遗 传 算 法 的 机 器 人 最 优 路 径 搜索 与 规划 方法 。 
为 了 实现 在 机 器 人 从 起 点 运动 到 目标 点 的 不 同 路 径 中 寻 

找 一 个 在 移动 过 程 中 不 与 任何 障碍 物 发 生 碰撞 的 可 行路 径 ， 

同时 降低 计算 复杂 度 , 减少 运算 时 间 , 提高 复杂 环境 适应 度 ， 
本 文 在 前 人 研究 的 基础 上 ， 提 出 一 种 复杂 2D 环境 中 的 基于 
自 适应 遗传 算法 (adaptive genetic algorithm, AGA) 的 机 器 人 

运动 规划 方法 ,首先 , 利用 随机 Dijkstra 算法 创建 初始 种 群 ; 
其 次 ， 在 遗传 算法 的 每 一 代 中 ， 改 进 所 创建 的 路 径 ， 并 用 自 
适应 算 子 替代 常规 选择 算 子 ， 最后， 通过 搜索 过 程 趴 
信息 ， 可 以 令 自 适应 选择 算 子 在 整个 算法 运行 中 恰当 地 控制 
选择 压力 。 值 得 注意 的 是 ， 机 器 人 运动 规划 问题 是 一 个 约束 
优化 问题 。 为 了 解决 这 个 问题 ， 基 于 AGA 方法 创建 初始 种 
群 ,生成 了 一 个 在 短 时 间 内 具有 适当 价值 的 多 样 化 初始 种 群 ， 
同时 提高 算法 执行 效率 ， 实 现 计算 复杂 度 和 最 佳 可 行 解 之 间 
的 动态 平衡 。 此 外 ， 所 提 方 法 通过 在 主体 中 应 用 新 的 自 适 应 
选择 算 子 来 克服 局 部 陷阱 问题 ， 该 算 子 可 以 通过 使 用 来 自 搜 


索 程 序 的 反馈 信息 实现 在 线 选择 压力 的 自动 调整 ， 进 而 提高 
个 体 的 多 样 性 ， 有 助 于 避免 算法 过 早 收敛 和 局 部 优化 。 通 过 
使 用 交叉 和 变异 算 子 ， 在 每 一 代 中 创建 多 个 恰当 的 后 代 以 达 
上 最 佳 可 行 解 。 为 了 验证 所 提 方 法 的 有 效 性 ， 在 MATLAB 
Ph 建立 了 仿真 模型 ， 并 将 所 提 方 法 与 另外 两 种 经 典 方法 进行 
了 对 比分 析 ， 实 验 结果 表明 所 提 方 法 在 最 优 路 径 选 择 和 计算 
复杂 度 方面 具有 非常 明显 的 优势 。 
1 ”机 器 人 运动 规划 概述 
本 章 简 要 介绍 机 器 人 运动 规划 问题 1。 假设 机 器 人 的 运 
动 环 境 为 E ， 包 括 障碍 物 和 机 器 人 运动 环境 。 在 E 中， 定义 
所 有 障碍 物 的 集合 为 0: 
O={01,0,,...,0m} (1) 
其 中 : o; 是 机 器 人 运动 环境 的 第 i 个 障碍 。 
定义 机 器 人 不 能 移动 的 禁止 空间 Sr 为 
Sm = Uo Q) 
其 中 : Sw 是 E 中 所 有 障碍 物 的 集合 。 
定义 机 器 人 可 以 自由 移动 的 空间 Sx 为 
Soe = E\ Spo G) 
图 1 给 出 了 机 器 人 运动 环境 E 、 禁 止 空间 5 和 自由 移 
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问题 建 模 为 一 个 优化 问题 并 对 
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其 进行 求解 ， 即 可 实现 机 器 人 


路 径 规划 的 最 优 设计 。 
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图 1 机 器 人 运动 空间 示例 
Fig. 1 Example of robot motion space 


2 ”二 维 环境 中 新 型 路 径 规划 方法 
遗传 算法 (genetic algorithm, GA) 是 一 种 通过 模拟 自然 


进化 过 程 来 搜索 最 人 
jos19。 为 了 解决 机 器 人 运动 规划 问题 ， 提 出 了 


人 饭 应 | 


ti 解 的 方法 ， 已 经 在 实际 工程 中 得 到 了 管 


一 种 新 


的 GA, 通过 Dijkstra 算法 和 基于 随机 的 方法 的 组 合 创建 具有 


不 同 个 体 的 适当 的 初始 种 群 ， 
了 调整 选择 压力 


从 而 提高 初始 种 群 的 质量 ;为 


防止 算法 


的 过 早 收 傅 ， 设 计 了 基于 秩 的 选 


择 算 子 ， 从 而 实现 选择 算 子 的 自动 调整 。 


2.1 个 体 描述 


机 器 人 移动 的 最 佳 路 径 是 指 ， 在 表 型 空间 中 机 器 人 在 不 


与 任何 障碍 物 发 


E 磁 撞 的 前 担 下 ， 顺 利 到 达 目 


标点 的 路 径 。 


为 了 将 问题 的 解 从 表 型 空间 映射 到 基因 型 空间 ， 需 要 对 个 体 
进行 适当 描述 。 在 所 提出 的 方法 中 ， 问 题 表 示 为 : 为 每 个 解 / 
路 径 分 配 一 个 个 体 ， 每 个 基因 代表 机 器 人 运动 环境 中 的 一 个 
点 /基因 ， 坐 标 为 (cy])， 通 过 将 所 有 基因 进行 有 机 排列 来 为 机 
器 人 运动 设计 路 径 ， 从 而 构成 了 GA 算法 的 个 体 结构 。 


2.2 初始 种 群 


初始 种 群 的 选择 对 于 GA 算法 来 说 非常 重要 ， 提 出 一 种 


动 空 间 Sn 的 示意 图 。 图 中 ， 虚 线 区 域 是 yw， 除 5w 之 外 的 
区 域 是 $m 。 

基于 上 述 的 定义 和 符号 ， 给 出 机 器 人 运动 规划 问题 的 数 
学 描述 为 


T( pyar Pusa)=atgmind(p) (4) 
Per 


其 中 : 7T(puorpasa) 是 起 始点 ps 与 目标 点 Pase 之 间 的 最 优 路 


径 ; 集合 表示 5 中 起 始点 和 目标 点 之 间 所 有 的 可 行路 径 ; 
4(P) 表示 路 径 ? 的 长 度 。 
4d(p) 的 数学 表达 式 为 


d(P)= 立 Iz -pe 


(5) 


|pi— pasl= NX 一 2 ) +(y;— ya) 
其 中 : |pi-pii 是 点 Pi 和 点 pi 之 间 的 欧式 距离 ; (%,y) 是 p; 的 
坐标 。 
在 上 述 数学 模型 的 基础 上 ， 本 文通 过 将 机 器 人 运动 规划 


基于 新 型 离散 算法 的 初始 种 群 创 建 方法 。 
机 器 人 运动 环境 已 


随机 选择 多 个 点 ， 


在 传统 算法 中 ， 从 
以 随机 顺序 将 这 些 


点 创建 为 个 体 ， 且 这 些 创 建 的 个 体 有 机 会 成 为 可 行 的 路 径 。 
然而 机 器 人 运动 环境 越 复杂 ， 包 含 的 障碍 物 越 多 ， 对 于 个 体 


种 新 型 的 可 行 个 


区 


So 


全 撞 ， 币 


连接 到 起 点 ， 


的 网 格 ， 
它 从 该 组 点 中 移 除 ， 如 图 2 所 示 。 


] 个 相 邻 点 ， 连 接 两 个 顶点 的 边 的 权重 等 
两 个 顶点 之 间 的 距离 ， 从 而 构成 一 个 加 权 图 。 
有 顶点 都 包含 于 
且 不 能 保证 
0) 将 起 点 和 目标 
类 似 


S pee ， 


而 言 可 行 的 机 会 越 少 ， 所 创建 的 初始 种 群 的 质量 越 差 。 
考虑 到 传统 方法 创建 的 可 行 个 体 的 概率 较 低 ， 提 出 了 一 
体 创建 方法 。 
a) 机 器 人 运动 环境 网 格 化 表示 。 
分 割 为 一 些 相 等 
障碍 物 上 ， 则 将 
b) 构 建 路 径 
个 点 只 连接 到 其 


将 机 器 人 的 运动 环境 E 
如 果 每 个 网 格 的 中 心 像素 位 于 任 一 


将 步骤 a) 中 剩 下 的 可 ) 


j 点 视 为 项 点， 每 


在 该 图 中 ， 所 
然而 该 图 的 部 分 边 可 能 与 障碍 物 发 生 
图 的 所 有 边 都 包含 于 5 ,如 图 3 所 示 。 


点 添加 到 道路 图 中 ， 通 过 将 最 近 的 顶点 
也 通过 将 最 近 的 项 点 连接 到 目标 点 ， 来 构 


建 本 质 上 为 加 权 有 向 图 的 路 径 图 。 


a 日 于 || 
v 合 作 期 刊 
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Se oi CO 开始 
OIiO ie 加 本 加 可 :O 


里 


人 4 输入 机 器 人 运动 环境 E | 


je] 二 0 i lel SS 


v 


将 运动 环境 离散 化 为 网 格 | 


里 


将 中 心 像素 置 于 集合 P 中 | 


图 2 机 器 人 运动 环境 网 格 示例 
Fig. 2 Example of robot motion environment grid 移 除 P 中 与 障碍 物 碰撞 的 点 


YY 


路 径 图 的 边 的 权重 幅 值 | 


YY 


将 起 点 和 终点 添加 到 路 径 图 中 


Rd | 


时 
基于 Dijsktra 算 法 得 到 
图 3 路 径 图 结构 示例 合适 的 个 体 

Fig.3 Example ofpath diagram structure y 
为 了 在 路 径 图 中 找到 从 顶点 到 目标 定点 的 最 短路 径 ， 采 这 加 从 过 的 必要 | 


用 文献 [20] 中 提 及 的 Dijkstra 算法 。 最短 路径 的 顶点 创建 了 一 
个 合适 的 个 体 ， 其 对 应 着 长 度 相 对 较 短 的 路 径 ， 同 时 该 个 体 - 
尽 可 能 不 与 任何 障碍 物 发 生 碰撞 。 借 助 建立 的 机 器 人 运动 环 和 
境 网 格 ， 可 以 利用 上 述 算法 创建 不 同 的 个 体 。 如 果 网 格 化 机 和 4 ”初始 种 群 创建 流程 
器 人 运动 环境 中 每 个 矩阵 单元 的 长 度 发 生 改 变 ， 则 路 径 图 的 Fig.4 Flow chart of initial population creation 
顶点 数量 和 图 形状 也 会 改变 ， 进 而 导致 创建 的 个 体 也 会 发 生 为 了 解决 上 述 问 题 ， 提 出 一 种 选择 压力 自动 调节 方法 ， 
改变 。 所 提 初 始 种 群 的 选取 方法 的 流程 如 图 4 所 示 。 通过 在 搜索 过 程 中 对 结果 进行 有 效 分 析 ， 可 以 实现 选择 压力 
值得 注意 的 是 , Dijsktra 算法 可 以 用 于 找到 加 权 有 向 图 中 的 精确 调整 ， 从 而 有 效 地 保持 种 群 的 多 样 性 ， 同 时 防止 寻 优 
两 个 顶点 之 间 的 最 短路 径 。 针 对 所 使 用 的 数据 结构 的 不 同 ， 算法 的 过 早 收敛 。 
Dijsktra 算法 存在 三 种 常见 的 实现 类 型 。 本 文 使 用 基于 一 进 制 利用 个 体 适应 度 的 标准 偏差 来 计算 表征 种 群 多 样 性 的 标 
数据 结构 的 、 运 行 时 间 为 0((&+V)logV) 的 Dijsktra 算法 ， 人 
| 其 中 : V 表示 图 形 顶 点 的 数量 ; 表示 图 形 边缘 的 数量 。 的 标准 之 一 ， 因 此 选择 个 体 适应 度 的 标准 偏差 来 调整 4 。 
2.3 选择 算 子 个 体 适 应 度 的 标准 偏差 计 为 
在 GA 算法 中 ， 为 了 选择 用 于 交叉 的 亲本 ， 同 时 为 了 实 -7 (10) 
现 收敛 速度 和 种 群 多 样 性 的 平衡 ， 设 计 一 种 可 以 在 线 调 整 选 
择 压力 的 基于 等 级 的 选择 算 子 。 为 了 选择 合适 的 交叉 个 体 ， 其 中 : a n 是 个 体 数量 ;上 是 第 : 
定义 如 下 非 线性 选择 概率 : pe 度 ; 了 是 适应 度 的 平均 值 。 
Rh 0) i 
A(1-1)-0.01, $<h 
其 中 : 2 是 第 i 个 个 体 的 选择 概率 ; 4 用 来 控制 选择 压力 ; “5 4(1)=) 41-1), hgh (11) 
是 第 i 个 个 体 的 秩 。 最 佳 个 体 的 秩 应 为 零 ， 而 最 差 的 个 体 秩 40 g>6 
应 等 于 PS-1， PS 表示 初始 种 群 的 大 小 。 其 中 : 4(n) 表示 第 1 代 的 4， 且 0<4<1 
式 (7) 可 得 最 佳 个 体 的 选择 概率 为 式 (11) 的 含义 为 : 如 果 # 的 值 小 于 阐 值 , 则 种 群 的 多 样 
=4 (8) ”性 会 减少 , 因此 必须 减 小 4 的 值 以 保持 种 群 的 多 样 性 ; 如 果 $f 


类 似 地 ， 最 差 个 体 的 选择 概率 为 


P=4(-4) (9) 


的 值 在 闵 值 h 和 加之 间 ， 那 么 4 是 常数 ， 如 果 # 的 值 大 于 阐 
值 ， 则 表示 有 一 个 可 用 的 多 样 性 种 群 ， 此 时 通过 增加 4 的 
值 可 以 适当 增加 选择 压力 , 从 而 提高 合适 个 体 被 选择 的 机 会 。 
式 (8)(9) 可 知 , 4 越 大 , 合适 个 体 被 选择 的 概率 就 越 大 ， 为 了 使 用 预定 概率 来 选择 个 体 ， 采 用 基于 随机 通用 采样 
不 合适 个 体 被 选择 的 概率 越 小 。 如 果 不 对 GA 中 的 选择 压力 ”的 个 体 选择 算法 ， 该 类 算法 具有 速度 快 〈 仅 需要 运行 一 次 算 
进行 合理 调整 ， 那 么 种 群 的 多 样 性 可 能 会 丧失 ， 且 种 群 很 快 法) 和 精度 高 的 优点 。 

就 会 收敛 于 局 部 最 优 解 。 于 交叉 的 第 i 个 个 体 的 期 望 拷贝 数 为 


Re 
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E(n)=7yxP (12) 行 的 个 体 ， 则 必须 向 其 分 配 高 的 惩罚 值 ， 从 而 将 其 从 种 群 中 
其 中 : 7 是 用 于 交叉 的 个 体 数 量 ; PB 是 第 i 个 个 体 的 选择 概 移 除 。 
率 ; ni 是 第 i 个 个 体 的 数量 。 2.7 生存 选择 
2.4 交叉 算 子 为 了 确保 获得 正确 的 解决 方案 ， 在 算法 运行 过 程 中 保持 


为 了 创建 新 的 后 代 ， 需 要 借助 单 点 交叉 算 子 。 首 先 ， 在 。 种 群 大 小 不 变 的 同时 ， 需 要 采用 基于 精英 主义 的 生存 选择 方 
每 个 个 体 的 路 径 上 随机 选择 一 个 点 ， 其 次 ， 将 两 个 父 代 的 路 。 ”法 ， 即 在 保留 当代 一 半 个 体 的 同时 ， 男 一 半 个 体 被 利用 所 提 
径 在 所 选择 的 点 处 进行 互 换 。 换 言 之 ， 第 一 个 后 代 的 路 径 的 。 ”方法 创建 新 个 体 蔡 代 。 

半 是 由 第 一 个 父 代 构建 的 ， 而 另 一 半 是 由 第 二 个 父 代 构 建 2.8 终止 条 件 


的 ; 第 二 个 后 代 的 路 径 的 一 半 也 是 由 第 二 个 父 代 构建 的 ， 而 为 了 在 得 到 最 优 解 的 同时 终止 所 提 算 法 ， 给 出 如 下 终止 

其 男 一 半 是 由 第 一 个 父 代 构建 的 。 通 过 交叉 运算 过 程 ， 可 以 ” 条 件 : 代 的 数量 达到 200; 算法 的 最 大 运行 时 间 超 过 预定 时 

创建 两 个 新 的 后 代 。 间 ( 本 文 取 为 5 min); 算法 找到 了 全 局 最 优 解 〈( 即 开始 点 和 

2.5 变异 算 子 目标 点 之 间 的 欧 几 里 德 距离 最 小 ); 在 100 个 连续 代 中 , 最 佳 

变异 算 子 的 作用 是 在 后 代 中 创建 随机 微小 的 变化 以 提高 “个体 的 适应 度 函 数值 保持 不 变 。 

后 代 的 稳定 性 ， 从 而 避免 算法 陷入 免 局 部 最 优 的 可 能 性 。 未 3 ”实验 结果 

文选 取 的 算 子 〈 随 机 选择 的 基因 ) 是 机 器 人 运动 路 径 上 的 一 9 

个 点 ， 通 过 研究 该 典型 点 的 所 有 8 个 可 能 的 邻 点 来 选择 产生 为 了 验证 所 提 方 法 的 有 效 性 ， 在 MATLAB 中 进行 了 仿 

最 小 值 的 最 佳 可 能 点 ， 然 后 用 新 选择 的 点 代替 前 一 个 点 。 图 真 分 析 ， 同 时 设计 了 6 种 环境 用 于 模拟 机 器 人 在 真实 世界 中 

5 显示 了 典型 点 的 8 个 相 邻 点 。 的 运动 环境 (图 6)， 实 验 结果 如 表 1 所 示 。 计 算 机 硬件 仿真 
平台 的 参数 如 下 : 惠普 690-078CCN， 处 理 器 i7-8700， 主 频 


16 GHz, 机 械 硬 盘 1T, 固态 硬盘 256 GB, 独 显 GTX1060 6G 。 
图 6 和 表 1 可知， 所 提 方 法 可 以 令 机 器 人 在 不 同 环境 下 以 
最 优 路 径 实现 从 出 发 点 到 目标 点 的 快速 移动 ， 且 运行 时 间 均 
小 于 5s, 表 明 所 提 方 法 可 以 在 2D 环境 中 实现 机 器 人 的 快速 、 
高 精度 、 无 碰撞 路 径 规划 。 


图 5 


典型 点 的 8 个 相 邻 点 
Fig. 3 8adjacent points oftypical points 

2.6 适应 度 函 数 
机 器 人 运动 规划 问题 的 目标 是 找到 起 点 与 目标 点 之 间 的 
最 佳 的 无 碰撞 路 径 。 为 了 达到 目标 ， 所 提出 方法 的 适应 度 函 
数 必须 考虑 路 径 的 可 行 性 和 质量 。 在 这 个 问题 中 ,个 体 路 径 \ \ 
的 可 行 性 可 视 为 一 种 约束 ， 目 前 已 有 各 种 方法 来 解决 进化 算 \ em 
法 中 的 约束 问题 。 这 些 方法 包括 直接 约束 处 理 〈 即 算法 运行 | eal 
过 程 中 进行 处 理 ) 和 间接 约束 处 理 〈 即 将 所 有 约束 转换 为 优 (a) 环 境 1 (b) 环 境 2 
化 目标 )。 在 完成 约束 处 理 的 基础 上 , 进化 算法 利用 适应 度 函 (a) Environment 1 (b) Environment 2 

采用 间接 方法 来 处 理 路 径 的 可 行 性 约束 ， 适 应 度 函 数 为 i 


Falp, Pin ) 可 行路 径 BB 到 
/=] 中 (13) 1 7 
dap, Pin)+ w(t)xp, 其 他 


HI 


其 中 : 4d (pi,pin) 是 机 器 人 运动 路 径 上 两 个 连续 点 之 间 的 欧 几 
里 德 距离 ，w(?) 为 惩罚 权重 ; p 为 惩罚 系数 ， 用 来 表示 个 体 的 : ! 

可 行 性 约束 的 违反 率 ， 可 以 用 来 表征 机 器 人 运动 路 径 的 碰撞 (0O) 环 境 3 (d) 环 境 4 
速率 。 式 (13) 中 ， 可 行 个 体 的 适应 度 函 数 等 于 机 器 人 运动 路 (c) Environment 3 (d) Environment 4 
径 的 长 度 。 如 果 机 器 人 运动 路 径 不 可 行 ， 则 需要 对 路 径 增加 图 
-Ef 从 | i mm 

第 : 代 中 与 德 罚 相关 的 惩罚 权重 w() 的 表达 式 为 es 
w(D)=4.6 (14) | 和 
其 中 : w(7) 表示 在 GA 第 : 代 中 与 惩罚 相关 的 权重 ; A 与 0 | “ : ; 
均 为 常数 ， 通 常 取 A=100，0=1.001。 | : | 
式 (14) 表 明 ， 通 过 增加 GA 的 代数 ， 惩 罚 效 应 可 以 呈现 和 
指数 级 增加 。 由 此 可 知 ， 通 过 增加 GA 的 代数 ， 可 以 将 不 可 
行 的 个 体 从 种 群 中 移 除 ， 这 是 因为 不 可 行 的 个 体 具 有 更 高 的 (e) 环 境 5 (环境 6 
惩罚 值 。 当 这 些 不 可 行 个 体 被 从 种 群 中 移 除 时 ， 所 提 方 法 可 (e) Environment 5 ( Environment 6 
以 确保 算法 在 可 行路 径 上 工作 并 尝试 减少 其 惩罚 。 因 此 ， 如 图 6 机 器 人 在 六 种 环境 中 的 运动 轨迹 
果 GA 运算 符 《〈 如 交叉 运算 符 等 ) 导致 可 行 的 个 体 变 为 不 可 Fig.6 Motion trajectories of robots in six environments 
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表 1 所 提 方 法 在 六 种 环境 中 的 实验 结果 


Table ] Experimental results of proposed method in six environments 
环境 不 可 行 解 的 数量 。 最 佳 适应 度 值 ” 代 的 数量 ”运行 时 间 /s 

1 0 21.56 104 3.62 

2 0 19.78 100 3.58 

3 0 25.61 110 4.11 

4 0 28.13 101 4.02 

5 0 21.76 103 3.81 

6 0 17.69 107 3.04 
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表 200 次 实验 后 适应 度 函数 的 平均 值 和 最 佳 值 。 由 结果 可 知 ， 
所 提 方 法 可 以 实现 适应 度 函 数值 的 快速 收敛 ， 同 时 保证 适应 
度 函 数 的 平均 值 和 最 佳 值 趋 于 一 致 。 
为 了 展示 所 提 遗 传 算法 在 解决 机 器 人 路 径 规划 中 的 优势 ， 
将 所 提 方 法 与 文献 [21 和 [22] 中 的 已 有 遗传 算法 进行 了 对 比 
实验 分 析 ， 实 验 结果 如 表 2、3 所 示 。 由 实验 结果 可 知 ， 所 提 
方法 可 以 实现 机 器 人 路 径 寻 优 ， 且 由 于 所 提 方 法 具备 算 子 自 
动 调整 功能 ， 可 以 防止 算法 的 过 时 收敛， 所 以 不 存在 不 可 行 
解 。 虽 然 所 提 方 法 的 代数 较 多 ， 但 在 两 种 环境 中 的 计算 时 间 


| 


bu 


图 7 给 出 了 随 着 迭代 次 数 的 增加 ， 所 提 方 法 在 六 种 环境 
中 适应 度 函 数 的 变化 趋势 。 其 中 横 轴 代表 人 迭代 次 数 ， 纵 轴 代 


与 文献 [21] 和 [22] 相 比 并 无 太 大 优势 , 但 这 样 的 计算 速度 是 可 
以 满足 机 器 人 运动 对 时 效 性 的 要 求 的 。 


本 本 全 
60 a 60 60 上 区 
一 一 环境 1 最 佳 适应 度 值 环境 1 最 佳 适应 度 值 环境 1 最 佳 适应 度 值 
so NV 环境 1 平均 适应 度 值 sol\N 环境 1 平均 适应 度 值 s0k 环境 1 平均 适应 度 值 
迎 40 上 
加 
习 30 上 
刘 30 
20F 
10 上 10 上 10 上 
0 1 1 1 1 1 0 d= = 1 1 1 > 0 1 1 hn 1 1 
0 40 80 120 160 200 0 40 80 120 160 200 0 40 80 120 160 200 
夫 代 次 数 和 迭代 次 数 和 迭代 次 数 
(a) 环境 1 (0) 环境 2 (0) 环境 3 
(a) Environment 1 (b) Environment 2 (c) Environment 3 
本 本 本 
60 上 ee 60 Co 60r 说 | 是 基 遍 启 当 
环境 1 最 佳 适应 度 值 \ 一 一 环境 1 最 佳 适应 度 值 环境 1 最 佳 适应 度 值 
so 环境 1 平均 适应 度 值 so NN 环境 1 平均 适应 度 什 jo 环境 1 平均 适应 度 值 


10 上 上 | 10 上 
0 1 1 上 > 0 1 1 1 1! LL.—=% 0 1 1 1 1 1 村 
0 40 80 120 160 200 0 40 80 120 160 200 0 40 80 120 160 200 
友 代 次 数 和 友 代 次 数 友 代 次 数 
(d) 环境 4 (e) 环境 5 (1) 环境 6 


(d) Environment 4 


(e) Environment 5 


( Environment 6 


图 7 ”所 提 方 法 在 六 种 不 同 环境 中 的 性 能 


Fig.7 Performance of proposed method in six different environments 


表 2 机 器 人 运动 环境 1 中 不 同方 法 的 实验 结果 


Table 2 Experimental results of different methods in robot motion 


environment 1 


方法 不 可 行 解 的 数量 最 佳 适应 度 值 代 的 数量 计算 时 间 


文献 [21] 中 的 方法 13 35.62 27 2.89s 
文献 [22] 中 的 方法 9 33.91 21 3.04s 
所 提出 的 方法 0 26.59 115 3.25s 


表 3 机 器 人 运动 环境 2 中 不 同方 法 的 实验 结 
Table3 Experimental results of different methods in robot motion 
environment 2 


方法 不 可 行 解 的 数量 最 佳 适 应 度 值 代 的 数量 计算 时 间 


文献 [21] 中 的 方法 46 31.25 58 3.17s 
文献 [22] 中 的 方法 62 29.68 61 3.21s 
所 提出 的 方法 0 21.13 107 3.61s 
4 ”结束 语 


针对 2D 环境 中 机 器 人 运动 规划 问题 ， 本 文 提出 了 一 种 
基于 新 型 遗传 算法 的 路 径 规划 方法 : 通过 Dijkstra 算法 和 随 
机 生成 方法 创建 了 初始 种 群 ， 在 算法 的 每 一 代 中 ， 改 进 所 创 
建 的 路 径 。 在 所 提 方 法 中 ， 利 用 自 适应 算 子 蔡 代 现 有 遗传 算 


UD 


法 中 的 常规 选择 算 子 ， 同 时 通过 使 用 搜索 过 程 中 的 个 体 适 应 
度 值 和 标准 偏 ， 自 适应 地 选择 算 子 ， 从 而 在 整个 算法 运行 中 
合理 地 控制 选择 压力 。 此 外 ， 基 于 提出 的 自动 调节 方法 可 视 
实现 选择 算 子 的 自动 调整 ， 从 而 防止 算法 的 过 早 收 化 ， 进 而 
有 效 地 保持 个 体 的 多 样 性 。 实 验 结果 表明 ， 与 其 他 现 有 遗传 
方法 相 比 ,所 提 方 法 在 可 行路 径 搜 寻 中 具有 非常 明显 的 优势 。 
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